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(54) Abstract Title: Vehicle control according to road flatness indices 



(57) A method of controlling a motor vehicle (10 see fig 
1 ) comprises estimation of two road flatness 
indices and determination of a road pitch and a roll 
angle. A control system 18 comprises a controller 
26 which receives inputs from wheel speed sensors 
20 and sensors for yaw rate 28, lateral acceleration 
32, roll rate 34, longitudinal acceleration 36 and 
pitch rate 37. The indices may be used in the 
determination of the road pitch slope and the road 
bank angle. The indices may be functions of a 
relative roll angle or a relative pitch angle. Steady 
state roll and pitch angles may also be calculated. 
The system 18 may control or activate an active 
brake control system 41, an active front or rear 
steering system 42,43, an active anti-roll bar system 
45 or an active suspension system 44, in response 
to the bank angle and pitch slope. 
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A CONTROL SYSTEM FOR A MOTOR VEHICLE 

The present invention relates generally to a control 
system for an automotive vehicle and more specifically, to a 
method and system for determining a surface profile of the 
road on which the vehicle is travelling and using such 
determination , to effect control of the vehicle. 

Dynamic control systems for automotive vehicles have 
recently begun to be offered on various products. Dynamic 
control systems typically control the yaw of the vehicle by 
controlling the braking effort at the various wheels of the 
vehicle. Yaw control systems typically compare the desired 
direction of the vehicle based upon the steering wheel angle 
and the direction of travel. By regulating the amount of 
braking at each corner of the vehicle, the desired direction 
of travel may be maintained. Typically, the dynamic control 
systems do not address roll of the vehicle. For high 
profile vehicles in particular, it would be desirable to 
control the rollover characteristic of the vehicle to 
maintain the vehicle position with respect to the road. 
That is, it is desirable to maintain contact of each of the 
four tyres of the vehicle on the road. 

In vehicle rollover control, it is desired to alter the 
vehicle attitude such that its motion along the roll 
direction is prevented from achieving a predetermined limit 
(rollover limit) with the aid of the actuation from the 
available active systems such as controllable brake system, 
steering system and suspension system. Although the vehicle 
attitude is well defined, direct measurement is usually 
impossible . 

There are two types of vehicle attitudes needed to be 
distinguished. One is the so-called global attitude, which 
is sensed by the angular rate sensors. The other is the. 
relative attitude, which measures the relative angular 



positions of the vehicle with respect to the road surface on 
which the vehicle is driven. The global attitude of the 
vehicle is relative to an earth frame (or called the inertia 
frame), sea level, or a flat road. It can be directly 
related to the three angular rate gyro sensors. While the 
relative attitude of the vehicle measures the relative 
angular positions of the vehicle with respect to the road 
surface, which are always of various terrains. Unlike the 
global attitude, there are no gyro-type sensors which can be 
directly related to the relative attitude. A reasonable 
estimate is that a successful relative attitude sensing 
system utilises both the gyro-type sensors (when the road 
becomes flat,, the relative attitude sensing system recovers 
the global attitude) and some other sensor signals. 

One reason to distinguish relative and global attitude 
is due to the fact that vehicles are usually driven on a 3- 
dimensional road surface of different terrains, not always 
on a flat road surface. Driving on a road surface with a 
large road bank does increase the rollover tendency, i.e., a 
large output from the global attitude sensing system might 
well imply an uncontrollable rollover event regardless of 
the flat road driving and the 3-D road driving. However 
driving on a three-dimensional road with moderate road bank 
angle, the global attitude may not be able to provide enough 
fidelity for a rollover event to be distinguished. 

Vehicular rollover happens when one side of the vehicle 
is lifted from the road surface with a long duration of time 
without returning back. If a vehicle is driven on a banked 
road, the global attitude sensing system will pick up 
certain attitude information even when the vehicle does not 
experience any wheel lifting (four wheels are always 
contacting the road surface) . Hence a measure of the 
relative angular positions of the vehicle with respect to 
the portion of the road surface on which the vehicle is 
driven provides more fidelity than global attitude to sense 



the rollover event when the vehicle is driven on a road with 
a moderate bank angle. Therefore it is important to 
identify road bank condition for proper vehicle rollover 
stability control . 

» 

Another example of detecting road profile could be used 
in powertrain controls, where the control of the air and 
fuel combination ratio or fuel ignition timing is such that 
they match the intention of a driver so as for the driving 
power or driving speed of the vehicle to match the present 
driving condition. Although the driver can identify the 
profile of a driving road and to control the vehicle 
accordingly, the road condition information has not been 
directly fed back to powertrain controls, since there is no 
road condition information detected and used for current 
vehicle control systems. Hence optimum fuel economy may not 
be achieved. 

US Patent 5,703,776 considers using a gear position 
sensing member of a transmission, an engine revolution 
sensing member, a loading degree sensing, a. brake pedal 
operating state sensing to provide a very crude measure of 
the longitudinal slope of the road surface. This invention 
provides a much more refined estimation of the road slope 
using the sensor sets equipped with vehicle dynamics control 
systems. 

In another example, an active roll control system using 
anti-roll-bar does not respond suitably to the side bank in 
conventional setting, since the presence of road side bank 
cannot be detected and the system therefore responds to a 
side bank as if the vehicle were cornering. This can result 
n in unnecessary power consumption for the active anti-roll- 
bar system. In order to eliminate this, WO 99/64262 
provides a very crude estimation of the road side bank using 
lateral acceleration sensor and vehicle reference speed. 
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In a further example, a vehicle driven on a road with a 
sharp side bank may cause false activation for the yaw 
stability control system and/or roll stability control 
system due to the fact that large lateral motion is 
determined through sensor signals even if the vehicle is 
driven in steady state condition on the banked road. 

It is an object of this invention to provide a system 
and method for accurately detecting the road side bank and 
the road longitudinal slope or pitch and to properly 
activate the vehicle control systems. 

According to a first aspect of the invention there is 
provided a control system for an automotive vehicle having a 
vehicle body comprising a first angular rate sensor 
generating a first angular rate signal corresponding to a 
first angular motion of the vehicle body; a second angular 
rate sensor generating a second motion signal corresponding 
to a second angular motion of the vehicle body; a lateral 
acceleration sensor generating a lateral acceleration signal 
corresponding to a lateral acceleration of a centre of 
gravity of the vehicle body; a longitudinal acceleration 
sensor generating a longitudinal acceleration signal 
corresponding to the longitudinal acceleration of the centre 
of gravity of the vehicle body; a wheel speed sensor 
generating a wheel speed signal corresponding to a wheel 
speed of the vehicle and a controller coupled to the first 
angular rate sensor, the second angular rate sensor, the 
lateral acceleration sensor, the longitudinal acceleration 
sensor and the wheel speed sensor wherein the controller is 
operable to determine a first flatness index and a second 
flatness index from the first angular rate signal, the 
second angular rate signal, the lateral acceleration signal 
and the longitudinal acceleration signal and the speed 
signal and the controller is operable to determine a road 
slope or pitch angle and a road bank angle in response to 
the first flatness index and the second flatness index. 



One advantage of the invention is that one angular rate 
sensor such as a pitch rate sensor may be eliminated. 

The first angular rate sensor may be one selected from 
the group of a yaw rate sensor, a pitch rate sensor and a 
roll rate sensor and the second angular rate sensor 
comprises is one selected frcm the group of a yaw rate 
sensor, a pitch rate sensor and a roll rate sensor, the 
second sensor being different than the first sensor. 

The first angular rate sensor may be a roll angular . 
rate sensor generating a roll angular rate signal 
corresponding to an roll angular motion of the vehicle body; 
the second angular rate sensor may be a yaw angular rate 
sensor generating a yaw rate signal corresponding to a yaw 
motion of the vehicle body and the controller may be 
operable to determine a relative pitch angle and relative 
roll angle as a function of the lateral acceleration signal, 
the longitudinal acceleration signal and the roll rate 
signal, determine a first flatness index as a function of 
the roll angular rate signal, the yaw angular rate signal, 
the relative roll angle and a relative pitch angle, 
determine a steady state pitch angle as a function of the 
vehicle speed and the longitudinal acceleration, determine a 
steady state roll angle as a function of lateral 
acceleration, vehicle speed and yaw rate and determine a 
second flatness index as a function of the steady state 
pitch angle, the relative pitch angle, the yaw rate, the 
steady state roll angle and a relative roll angle. 

The control system may further comprise a safety system 
coupled to the controller, the controller generating a 
control signal to the safety system as a function of the 
first flatness index and the second flatness index. 
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The safety system may comprise an active brake control 
system or may comprise an active rear steering system or may 
comprise an active front steering system or may comprise an 
active anti-roll bar system or may comprise an active 

» 

5 suspension system. 

According to a second aspect of the invention there is 
provided a method controlling an automotive vehicle 
comprising estimating a first flatness index indicative of 
10 road flatness; estimating a second flatness index indicative 
of road flatness; determining a road pitch slope in response 
to the first flatness index and the second flatness index 
and determining a road bank angle in response to the first 
flatness index and the second flatness index. 

15 

The method may further comprise the step of controlling 
a safety device as a function of the bank angle and the 
pitch slope of the driving road. 

20 The safety device may comprise a yaw control system or 

may comprise a rollover stability control system. 

The steps of determining a road pitch slope in response 
to the first flatness index and the second flatness index 
25 and determining a road bank angle in response to the first 
flatness index and the second flatness index may be 
performed when the first flatness index and the second 
flatness index are above a predetermined threshold. 

30 The method may further comprise determining a roll 

angular rate signal, a yaw angular rate signal, a relative 
roll angle and a relative pitch angle; wherein the first 
flatness index is a function of a first flatness index as a 
function of the roll angular rate signal, the yaw angular 

35 rate signal, the relative roll angle and a relative pitch 
angle . 



The method may further comprise determining a steady 
state pitch angle, a relative pitch angle, a yaw rate, a 
steady state roll angle and a relative roll angle; wherein 
the second flatness index is a function of the steady state 
5 pitch angle, the relative pitch angle, the yaw rate, the 
steady state roll angle and a relative roll angle 

According to a third aspect of the invention there is 
provided a method of controlling an automotive vehicle 

10 comprising measuring a roll rate of the vehicle body; 
measuring a lateral acceleration of the vehicle body; 
measuring the longitudinal acceleration of the vehicle body; 
measuring the yaw rate of the vehicle body; measuring a 
vehicle speed; determining a relative pitch angle and 

15 relative roll angle as a function of the lateral 

acceleration, the longitudinal acceleration and the roil 
rate signal; determining a first flatness index as a 
function of the roll angular rate, the yaw angular rate, the 
relative roll angle and a relative pitch angle; determining ' 

20 a steady state pitch angle as a function of the vehicle 
speed and the longitudinal acceleration; determining a 
steady state roll angle as a function of lateral 
acceleration, longitudinal speed and yaw rate; a determining 
a second flatness index as a function of the steady state 

25 pitch angle, the relative pitch angle, the yaw rate, the 
steady state roll angle and a relative roll angle and 
generating a control signal as a function of the first 
flatness index and the second flatness index. 

30 The method may further comprise the steps of 

determining a road pitch slope in response to the first 
flatness index and the second flatness index and determining 
a road bank angle in response to the first flatness index 
and the second flatness index. 
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The method may further comprise the step of activating 
a safety device as a function of the road bank angle and the 
road pitch angle. 

The safety device may comprise one selected from the 
group consisting of an active brake control system, an 
active rear steering system, an active front steering 
system, an active anti-roll bar system, and an active 
suspension system. 

The invention will now be described by way of example 
with reference to the accompanying drawing of which:- 

Figure 1 is a diagrammatic view of a vehicle with 
15 variable vectors and coordinator frames according to the 
present invention; 

Figure 2 is an end view of an automotive vehicle on a 

bank; 

20 

Figure 3 is a side view of a vehicle on a pitch slope; 

Figure 4 is a block diagram of a stability system 
according to the present invention; and 

25 

Figure 5 is flow chart of the operation according to 
the present invention. 

In the following figures the same reference numerals 
30 will be used to identify the same components. The present 
invention is preferably used in conjunction with a yaw 
control system or a rollover control system for an 
automotive vehicle. 
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However, the present invention may also be used with a 
deployment device such as airbag or roll bar. The present 
invention will be discussed below in terms of preferred 
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embodiments relating to an automotive vehicle moving in a 
three-dimensional road terrain. 

Referring now to Figure 1, an automotive vehicle 10 
5 with a safety system of the present invention is illustrated 
with the various forces and moments thereon. Vehicle 10 has 
front right and front left tyres 12a and 12b and rear right 
tyres and rear left tyres 13a and 13b, respectively- The 
vehicle 10 may also have a number of different types of 

10 front steering systems 14a and rear steering systems 14b 
including having each of the front and rear wheels 
configured with a respective controllable actuator, the 
front and rear wheels having a conventional type system in 
which both of the front wheels are controlled together and 

15 both of the rear wheels are controlled together, a system 
having conventional front steering and independently 
controllable rear steering for each of the wheels, or vice 
versa. 

20 Generally, the vehicle has a weight represented as Mg 

at the centre of gravity of the vehicle, where g = 9.8 m/s 
and M is the total mass of the vehicle. 

As mentioned above, the system may also be used with 
25 active/semi-active suspension systems, anti-roll bar or 
other safety devices deployed or activated upon sensing 
predetermined dynamic conditions of the vehicle. 

The sensing system 16 is coupled to a control system 
30 18. The sensing system 16 preferably uses a standard yaw 

stability control sensor set (including lateral acceleration 
sensor, yaw rate sensor, steering angle sensor and wheel 
speed sensor) together with a roll rate sensor and a 
longitudinal acceleration sensor. The various sensors will 
35 be further described below. 



The wheel speed sensors 20 are mounted at each corner 
of the vehicle, and the rest of the sensors of sensing 
system 16 are preferably mounted directly on the centre of 
gravity of the vehicle body, along the directions x, y and z 
shown in Figure 1. 

As those skilled in the art will recognize, the frame 
from bv ^ and 63 is called a body frame 22, whose origin is 
located at the centre of gravity of the car body, with 1 
corresponding to the x axis pointing forward, ^ 
corresponding to the y axis pointing off the driving side 
(to the left), and * 3 corresponding to the z axis pointing, 
upward. The angular rates of the car body are denoted about 
their respective axes as w * for the roll rate, Wy for the 
pitch rate and w * for the yaw rate. The present invention 
calculations preferably take place in an inertial frame 24 
that may be derived from the body frame 22 as described 
below. 

The angular rate sensors and the acceleration sensors 
are mounted on the vehicle car body along the body frame 
directions ^ * and b > , which are the x ' > ' 2 axes of the 
vehicle's sprung mass. 

The longitudinal acceleration sensor is mounted on the . 
car body located at the centre of gravity, with its sensing 
direction along 6| -axis, whose output is denoted as a * . The 
lateral acceleration sensor is mounted on the car body 
located at the centre of gravity, with its sensing direction 
along ^-axis, whose output .is denoted as 

The other frame used in the following discussion 
includes the road frame, as depicted in Figure 1. The road 
frame system r ^ is fixed on the driven road surface, where 
the r > axis is along the average road normal direction 
computed from the normal directions of the four tyre/road 
contact patches. 
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In the following discussion, the Euler angles of the 
body frame with respect to the road frame r ^ are 

denoted as and q=r , which are also called the relative 

Euler angles. 

The present invention estimates the relative Euler 
angles q " and * r based on the available sensor signals and 
the signals calculated form the measured values. 

Referring now to Figure 2, the present invention 
determines a road bank angle 9 ba nk/ which is shown relative to 
the vehicle 10 on a road surface. 



15 Referring now to Figure 3, the present invention 

determines a slope or pitch angle 9 s iope> which is shown 
relative to the vehicle 10 on the road surface. 

Referring now to Figure 4, roll stability control 
20 system 18 is illustrated in further detail having a . 

controller 26 used for receiving information from a number 
of sensors which may include a yaw rate sensor 28, a speed 
sensor 20, a lateral acceleration sensor 32, a roll rate 
sensor 34, a steering angle sensor (hand wheel position) 35, 
25 a longitudinal acceleration sensor 36, a pitch rate sensor 
37 and steering angle position sensor 39. 

In the preferred embodiment, only two axial rate 
sensors are used. When two of these axial rates are known, 
30 the other may be derived using other commonly available 

sensors. Preferably, yaw rate and roll rate are used as the 
axial rate sensors. Although pitch rate sensor 37 is 
illustrated, it can be eliminated in the preferred 
embodiment. 



35 



In the preferred embodiment, the sensors are located at 
the centre of gravity of the vehicle. Those skilled in the 



( 



- 12 - 



art will recognize that the sensor may also be located off 
the centre of gravity and translated equivalently thereto. 

Lateral acceleration, roll orientation and speed may be 

♦ 

5 obtained using a global positioning system (GPS) . Based 
upon inputs from the sensors, controller 26 may control a 
safety device 38. Depending on the desired sensitivity of 
the system and various other factors, not all the sensors 
28-39 may be used in a commercial embodiment. Safety device 

10 38 may control an airbag 40, an active braking system 41, an 
active front steering system 42, an active rear steering 
system 43, an active suspension system 44, and an active 
anti-roll bar system 45, or combinations thereof. Each of 
the systems 40-45 may have their own controllers for 

15 activating each one. As mentioned above, the safety system 
38 is preferably at least the active braking system 41, 

Roll rate sensor 34 and pitch rate sensor 37 may sense 
the roll condition of the vehicle based on sensing the 
20 height of one or more points on the vehicle relative to the 
road surface. Sensors that may be used to achieve this 
include a radar-based proximity sensor, a laser-based 
proximity sensor and a sonar-based proximity sensor. 

25 Roll rate sensor 34 and pitch rate sensor 37 may also 

sense the roll condition based on sensing the linear or 
rotational relative displacement or displacement velocity of 
one or more of the suspension chassis components which may 
include a linear height or. travel sensor, a rotary height or 

30 travel sensor, a wheel speed sensor used to look for a 
change in velocity, a steering wheel position sensor, a 
steering wheel velocity sensor and a driver heading command 
input from an electronic component that may include steer by 
wire using a hand wheel or joy stick. 



35 



The roll condition may also be sensed by sensing the 
force or torque associated with the loading condition of one 
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or more suspension or chassis components including a 
pressure transducer in active air suspension, a shock 
absorber sensor such as a load cell, a strain gauge, the 
steering system absolute or relative motor load, the 
5 steering system pressure of the hydraulic lines, a tyre 

lateral force sensor or sensors, a longitudinal tyre force 
sensor, a vertical tyre force sensor or a tyre sidewall 
torsion sensor. 

10 The roll condition of the vehicle may also be 

established by one or more of the following translational or 
rotational positions, velocities or accelerations of the 
vehicle including a roll gyro, the roll rate sensor 34, the 
yaw rate sensor 28, the lateral acceleration sensor 32, a 

is vertical acceleration sensor, a vehicle longitudinal 
acceleration sensor, lateral or vertical speed sensor 
including a wheel-based speed sensor, a radar-based speed 
sensor, a sonar-based speed sensor, a laser-based speed 
sensor or an optical-based speed sensor. 

20 • 

Based on the inputs from sensors 28 through 39 y 
controller 26 determines a roll condition and controls any 
one or more of the safety devices 40-45. 

25 Speed sensor 30 may be one of a variety of speed 

sensors known to those skilled in the art. For example, a 
suitable speed sensor may include a sensor at every wheel 
that is averaged by controller 26. Preferably, the 
controller translates the wheel speeds into the speed of the 

30 vehicle. Yaw rate, steering angle, wheel speed and possibly 
a slip angle estimate at each wheel may be translated back 
to the speed of the vehicle at the centre of gravity. 
Various other algorithms are known to those skilled in the 
art. For example, if speed is determined while speeding up 

35 or braking around a corner, the lowest or highest wheel 
speed may not be used because of its error. Also, a 
transmission sensor may be used to determine vehicle speed. 
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As mentioned above, 0 b ank and 9 slop e are the road side bank 
angle and longitudinal slope angle experienced by a vehicle 
driven. These variables are preferably factored into the 

< 

control algorithm of a rollover stability control system, or 
a yaw stability control system or other safety systems. Two 
variables and "a are used here, which are called 
flatness index 1 and flatness index 2. These variables are 
defined as: 



Fh = © Hank + 

t 



1.1 



FI FI 

where ^ is the yaw rate of the vehicle. ri| and ^ 
have the following properties: 

If the road surface is absolutely flat, then both 0 ba nk 
and Gsiope should be zero, hence ^ and F, i are both zero. 



FI 



i 



If the road surface is close to perfect flatness, 
and ^ 2 should be close to zero. 

If the road surface doesn't have longitudinal slope, 
^i = 0 means the road might have zero bank or constant bank. 

If further ^2 =0 , then the road must be flat if the yaw 
rate is non-zero. 

Based on the above discussion, a small magnitude for 

both flatness indices and F ** does indicate that the road 

surface under driving is close to a flat surface. To detect 

FI FI 

when the road is flat, the flatness indices rM \ and 2 are 
checked using available sensor signals. In the preferred 
embodiment, the lateral acceleration > , the longitudinal 
acceleration a * , the roll rate ®* and yaw rate ^ , and the 
calculated vehicle reference velocity re/ . Of course, the 
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pitch rate or other signals may be used while the other 
variables may be calculated. 

The relative roll and pitch angles between the vehicle 

0 6 

5 car body and the road surface are denoted as » and >' , 
which can be computed using the methods summarized in U.S. 
Patent Application [Ford invention disclosure 200-1749] 
filed on March 4, 2002, the disclosure of which is 
incorporated by reference herein. 

10 

If we compute the following at each time instant * 

RA(/c) = aco x (k) - ba y (/c) 

15 PA(/c) = cco y (k) - da x U) 

with properly chosen coefficients a ^^ c and d , and an 
estimated pitch rate ( ° y (which is a function of the roll 

0) 

rate, yaw rate, etc.) or a measured pitch rate y then the 
20 computation for the relative roll and pitch angles proposed, 
in the above patent application can be conducted as in the 
following 

q xr (k + 1) = eq xr {k) + f[RA{k + 1) + RA(k)] 
25 q yr {k + 1) = gq yr (k) + h[PA(k + 1) + PA(k)] 

with properly chosen coefficients e *f->% and 

The vehicle body global roll and pitch angles x and 

0 

30 y , which are measured with respect to sea level, can be 
computed as 
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Notice that, and y obey the following relationship 
with reasonable accuracy 



0 x *a> x + a)A, 1>3 



The estimated variable is defined based on the 

roll and yaw rate sensor measurements, and the calculated 
relative roll and pitch attitudes of the vehicle {which are 
further calculated from the longitudinal/lateral 
acceleration sensor measurements, and the roll rate sensor 
measurement- 



r^co x +co z e yr -o xr 1.4 

At the k-th time instant, the digital implementation of 
Equation (1.4) can be written as the following 

r l w = ^W+^(^W-^W i.5 

FI 

Based on (1.2) and (1.3), the flatness index ■ can be 

f 

approximately computed from >, or say 
Considering 

a s = v x -6) : v y -g$ y 
a y =v y +a) : v x + g0 x 

The steady state roll and pitch attitudes of the 
vehicle may be defined as 



1.6 



- 17 - 



yss 

8 1.7 

a — co v 
q — >' - l 

xss 

g 

The estimated variable T 2 is based on the steady 
state roll and pitch attitudes computed in (1.6) and the 
relative roll and pitch attitude (angle) 

o 1.8 

A digital implementation of (1.8) is used in practice 
In order to eliminate potential integration drift, an anti 
drift-integration filter of the following z-transf ormation 
may be used 

T (g -). rfQ-'V- 



If we define 



H=|[^„(r)-^(r)]rfT 

0 

then by passing 

*„(*)-*„<*) 

through this filter, © can be computed as the 
following 

E(* + l) = c,E(*)-c z E(*-l) 



and 2 may be then be expressed as the following 
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f , (* + 1) = 0,„ (* + 1) - 0„(* + 1) - (o s (k + 1)E(* + 1) 

By eliminating lateral velocity v from (1.6), the 
following holds 



1.10 



a> z \e x {v)dx -6, = a> : |^(r)rfr -0,„ 



1.11 



10 



r 

Thus, the calculated or estimate 2 is equivalent to 

FI 

the flatness index . 



That is, ^:(*) = r 2(*) a t each time instant. 



15 



r r 

Using the calculated 1[ and l 2, the following flat road 
detection logic can be obtained as in the following 



'/ r,(*)<min, and I\(/;)<min : 



road surface is almost flat 

else if r } (k) <= min, and r\(£)>max : 

road doesn't have dynamic side bank 
quantitatively computing bank I slope 

else if f ,(*)>= max, and V 2 (k) > max.. 



road has significant side bank I slope 
quantitatively computing bank I slope 



else 



quantitatively computing bank and slope 
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where max > and max 2 are thresholds. When the 
thresholds are exceeded, the road is not flat. The road 
pitch angle and the road bank angle may be used in the 
controlling of a safety device. That is, when the flatness 
indices are not small enough, the bank and pitch/slope is 
determined. In order to do so, the previously computed 

r r 

estimates > and 2 are used to formulate the following 
ordinary differential equations. 

The following differential equations derived from (1.1) 
are obtained. 

0 1.12 

© ©, 

In order to solve and **** from the differential 

0 

equation (1.12), **** is eliminated. 

0 1.13 

If the road bank is computed from (1.13), then the road 
slope can be expressed as 



r 



1.14 



If we define the yaw angle ' and an intermediate 



flatness variable as: 

0 



r 



r = r, + <w.r, 



1 . 15 



then the road bank angle obeying (1.13) can be 
expressed as in the following: 



®^ (0 = sin(n ; ) Jr(r) sin(Q r )dv + cos(n, ) J r(r) cos(O r )dr 

° 0 1.16 



The numerical implementation of the closed-form 
solution in (1.16) is used in practice. The yaw angle of 

the vehicle car body as defined in (1.15) , may be 

computed using the following pure integration scheme 

Cl(k + \) = Q(k) + co z (k + \)&T 1.17 

where AT is the sampling time of the control system/ 
+ and + are the values of the yaw angle and the 
yaw rate sensor at time instant '-(^ + 1)^7* 

Since the potential drift problem, (1.17) may not be 
close to the actual yaw angle. However n(£+l) appears only 

■ 

in s,n ' cos functions, the drifting could be eliminated by 
using the following congruent mod operation 

Q tf (k + 1) = Q(k + 1) - 2/r floor{ ° ( * - ** } 

2;r 1.18 

Notice that Q ^* + 1 ^ falls always within O.and 2 *. The 
Jloor^) ^ s a f unc tion which is the largest integer bounded, by 
the real number • . That is, 

Jloor{— ) 

In 

always removes out of the portion that are integer 
times of 2;r from + and it outputs a quantity with 
value falling in between 0 and . 
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This function is common in "C" programming language. 
The following intermediate variables may be computed. 

5 

r tf (A + i)=c,r w (*)-c,r,,(*-i) 

+ d{r{k + 1) sin(Q x (* + D) - r(* - l)sin(Q x . (k - I))] 

r„(*+t)=c,r c/ (A)-c 1 r t7 (*-i) 

+</[r(*+i)cos(n g (t+i))-r(*-i)cos(n x (A-i))] 11Q 

Using the numerical scheme shown in (1.13), the 
following computation for the road bank and road slope 
10 angles can be provided where ^ is an intermediate variable. 

© iu „* (* + 0 = sin(fi(A + l))r v/ (* + 1) + cos(fl(* + l»r a (* + 1) 
4>(* + l) = T(*) + Ar©^(* + l) 

©^(*+i) = r,(*+i)+ < y r (*+i)T(t+i) 12Q 

Referring now to Figure 5, a summary of the method 

■ « 

15 presented above is illustrated in flow chart form. In step 
70, the various sensors are read. 

In the present example, a roll rate sensor determines 
the roll rate of the vehicle, a lateral acceleration sensor 
20 generates a lateral acceleration signal of the vehicle body, 
a longitudinal acceleration sensor generates a longitudinal 
acceleration signal of the vehicle body, a yaw rate sensor 
generates a yaw rate signal. A longitudinal vehicle 
velocity or speed is also obtained. 

25 

In step 72, a number of intermediate dynamic conditions 
are determined from he measured sensor signal. The 
intermediate dynamic conditions may include pitch rate, 
relative pitch angle, relative roll rate, relative roll 
30 angle, steady state pitch angle, steady state roll angle, 
and global references of the conditions. 



( 



10 
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In step 74, a first flatness index is calculated from 
the conditions. This calculation is an estimate as 
described above. 

In step 76, a second flatness index is calculated from 
the conditions. This calculation is also an estimate as 
described above. 

In step 78 if. either the first index or the second 
index (or both) are above a threshold this indicates the 
road has a significant side bank or pitch slope. Step 80 is 
then executed. The bank and pitch slope are computed from 
the flatness indexes and various dynamic conditions as 
mentioned above. In step 82, a control system is activated 
15 as a function of bank and pitch slope. For example, when 

the bank and pitch slope are high, this may indicate an off- 
road condition, not a rollover condition. This may allow 
the rollover control system to adjust its rollover 
thresholds accordingly. 

20 * 

Referring back to step 78, if either index is not above 

their respective thresholds, step 70 is executed. 

While particular embodiments of the invention have been 
2b shown and described, it will be appreciated that numerous 
variations and alternate embodiments may occur to those 
skilled in the art without departing from the scope of the 
invention . 



30 
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Claims 

1. A control system for an automotive vehicle having 
a vehicle body comprising a first angular rate sensor 
generating a first angular rate signal corresponding to a 
first angular motion of the vehicle body; a second angular 
rate sensor generating a second motion signal corresponding 
to a second angular motion of the vehicle body; a lateral 
acceleration sensor generating a lateral acceleration signal 
corresponding to a lateral acceleration of a centre of 
gravity of the vehicle body; a longitudinal acceleration 
sensor generating a longitudinal acceleration signal 
corresponding to the longitudinal acceleration of the centre 
of gravity of the vehicle body; a wheel speed sensor 
generating a wheel speed signal corresponding to a wheel 
speed of the vehicle and a controller coupled to the first 
angular rate sensor, the second angular rate sensor, the 
lateral acceleration sensor, the longitudinal acceleration 
sensor and the wheel speed sensor wherein the controller is 
operable to determine a first flatness index and a second . 
flatness index from the first angular rate signal, the 
second angular rate signal, the lateral acceleration signal 
and the longitudinal acceleration signal and the speed 
signal and the controller is operable to determine a road 
slope or pitch angle and a road bank angle in response to 
the first flatness index and the second flatness index. 

2. A system as claimed in claim 1 wherein the first 
angular rate sensor is one selected from the group of a yaw 
rate sensor, a pitch rate sensor and a roll rate sensor and 
the second angular rate sensor comprises is one . selected 
from the group of a yaw rate sensor, a pitch rate sensor and 
a roll rate sensor, the second sensor being different than 
the first sensor. 

3. A system as claimed in claim 1 or in claim 2 
wherein the first angular rate sensor is a roll angular rate 



sensor generating a roll angular rate signal corresponding 
to an roll angular motion of the vehicle body; the second 
angular rate sensor is a yaw angular rate sensor generating 
a yaw rate signal corresponding to a yaw motion of the 
5 vehicle body and the controller is operable to determine a 
relative pitch angle and relative roll angle as a function 
of the lateral acceleration signal, the longitudinal 
acceleration signal and the roll rate signal, determine a 
first flatness index as a function of the roll angular rate 

10 signal, the yaw angular rate signal, the relative roll angle 
and a relative pitch angle, determine a steady state pitch 
angle as a function of the vehicle speed and the 
longitudinal acceleration, determine a steady state roll 
angle as a function of lateral acceleration, vehicle speed 

15 and yaw rate. and determine a second flatness index as a 

function of the steady state pitch angle, the relative pitch 
angle, the yaw rate, the steady state roll angle and a 
relative roll angle. 

20 4 . A control system as claimed in any of claims 1 to 

3 further comprising a safety system coupled to the 
controller, the controller generating a control signal to 
the safety system as a function of the first flatness index 
and the second flatness index. 

25 

5. A control system as claimed in claim 4 wherein the 
safety system comprises an active brake control system. 

6. A control system. as claimed in claim 4 wherein the 
30 safety system comprises an active rear steering system. 

7. A control system as claimed in claim 4 wherein the 
safety system comprises an active front steering system. 



35 



8. A control system as claimed in claim 4 wherein the 
safety system comprises an active anti-roll bar system. 
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9. A control system as claimed in claim 4 wherein the 
safety system comprises an active suspension system. 

10. A method controlling an automotive vehicle 
comprising estimating a first flatness index indicative of 
road flatness; estimating a second flatness index indicative 
of road flatness; determining a road pitch slope in response 
to the first flatness index and the second flatness index 
and determining a road bank angle in response to the first 
flatness index and the second flatness index. 

11. A method as claimed in claim 10 further comprising 
the step of controlling a safety device as a function of the 
bank angle and the pitch slope of the driving road. 

12. A method as claimed in claim 11 wherein the safety 
device comprises a yaw control system. 

13. A method as claimed in claim 11 wherein the safety 
device comprises a rollover stability control system. . 

14. A method as claimed in any of claims 10 to 13 
wherein determining a road pitch slope in response to the 
first flatness index and the second flatness index and 
determining a road bank angle in response to the first 
flatness index and the second flatness index are performed 
when the first flatness index and the second flatness index 
are above a predetermined threshold. 

15. A method as claimed in any of claims 10 to 14 
wherein the method further comprises determining a roll 
angular rate signal, a yaw angular rate signal, a relative 
roll angle and a relative pitch angle; wherein the first 
flatness index is a function of a first flatness index as a 
function of the roll angular rate signal, the yaw angular 
rate signal, the relative roll angle and a relative pitch 
angle. 
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16. A method as claimed in any of claims 10 to 15 
further comprising determining a steady state pitch angle, a 
relative pitch angle, a yaw rate, a steady state roll angle 
and a relative roll angle; wherein the second flatness index 
is a function of the steady state pitch angle, the relative 
pitch angle, the yaw rate, the steady state roll angle and a 
relative roll angle 

17. A method of controlling an automotive vehicle 
comprising measuring a roll rate of the vehicle body; 
measuring a lateral acceleration of the vehicle body; 
measuring the longitudinal acceleration of the vehicle body; 
measuring the yaw rate of the vehicle body; measuring a 
vehicle speed; determining a relative pitch angle and 
relative roll angle as a function of the lateral 
acceleration, the longitudinal acceleration and the roll 
rate signal; determining a first flatness index as a 
function of the roll angular rate, the yaw angular rate, the 
relative roll angle and a relative pitch angle; determining 
a steady state pitch angle as a function of the vehicle 
speed and the longitudinal acceleration; determining a 
steady state roll angle as a function of lateral 
acceleration, longitudinal speed and yaw rate; a determining 
a second flatness index as a function of the steady state 
pitch angle, the relative pitch angle, the yaw rate, the 
steady state roll angle and a relative roll angle and 
generating a control signal as a function of the first 
flatness index and the second flatness index. 

18. A method as claimed in claim 17 wherein the method 
further comprises the steps of determining a road pitch 
slope in response to the first flatness index and the second 
flatness index and determining a road bank angle in response 
to the first flatness index and the second flatness index. 
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19. A method as claimed in claim 18 wherein the method 
further comprises the step of activating a safety device as 
a function of the road bank angle and the road pitch angle. 

20. A method as claimed in claim 19 wherein the' step 
of activating a safety device comprises one selected from 
the group consisting of an active brake control system, an 
active rear steering system, an active front steering 
system, an active anti-roll bar system, and an active 
suspension system. 

21. A control system substantially as described herein 
with reference to the accompanying drawing. 

22. A method substantially as described herein with 
reference to the accompanying drawing. 
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